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Abstract of EP1 361459 

A car driver backing assistance system has long 
range radar, ultrasonic or optical sensor obstacle 
detection systems (3) measuring a convex 
obstruction profile using triangulation and short 
range (2) wheel and steering wheel (4) sensor 
systems used within a minimum distance. 
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(54) Fahrerassistenzsystem mit Koppelnavigation 

(57) Die Erfindung betrifft ein Fahrerassistenzsy- 
stem fur ein Fahrzeug mit 

Mitteln 3 zur Bestimmung einer ersten Position ei- 
nes Hindemisses mit Bezug auf das Fahrzeug, so- 
lange das Fahrzeug einen Mindestabstand zu dem 


Hindemis hat. 

Mitteln 2 zur Bestimmung einer zweiten Position 
des Hindemisses bei Unterschreitung des Mindest- 
abstands basierend auf einer Weg- und Lenkwin- 
kelmessung. 



0> 


CO 

CO 


EP 1 361 459 A1 


Beschreibung 

[0001] Die Erfindung betrifft ein Fahrerassistenzsystem, insbesondere eine Einparkhilfe oder einen sogenannten 
Parkpilot, bei dem eine Messung des Abstands eines Hindernisses zu dem Fahrzeug erfolgt. 
5 [0002] Aus der DE 303 60 81 A1 ist ein Verfahren zur Distanzmessung nach dem Ultraschall-Echoprinzip fur ein 
Kraftfahrzeug bekannt. Hierbei sind an verschiedenen Stellen des Fahrzeugs Ultraschallsensoren angeordnet, urn in 
dem Erfassungsbereich der Ultraschallsensoren befindliche Objekte zu detektieren. Eine Ermittlung der Position von 
Hindernissen ist mit diesem System nicht moglich. 

[0003] Aus der DE 43 33 357 A1 ist eine Weiterbildung dieses Verfahrens zur Distanzmessung nach dem Ultraschall- 

10 Echoprinzip bekannt. Auch bei dieser Weiterbildung wird lediglich der Abstand zu einem Hindernis, nicht aber die 
Position des Hindernisses mit Bezug auf das Fahrzeug erfasst. Bei Unterschreitung eines Mindestabstands zu dem 
Hindernis liefert der Ultraschallsensor keine hlnreichend genauen Werte mehr, so dass fur die Bestimmung des Ab- 
stands zu dem Hindernis zusatzlich die durch einen Wegsensor gemessene Wegstrecke berucksichtigt wird. 
[0004] Ferner sind aus dem Stand der Technik Fahrerassistenzsysteme bekannt, die im Allgemeinen auf Radarsen- 

15 soren, das heiftt insbesondere sogenannten Short-Range-Radarsensoren (SRR) basieren. Hierbei handelt es sich urn 
Einparksysteme, Ruckfahrhilfen ("Backing Aid"), Auffahrunfalldetektoren und andere Anwendungen. Auch bei solchen 
SRR basierten Systemen tritt das Problem auf, dass die Radarsensoren Abstandswerte nur bis zu einem Abstandswert 
von mindestens etwa 20 cm bis 50 cm liefern; bei einem geringeren Abstand liefert ein solcher Radarsensor kein fur 
die Abstandsmessung verwendbares Signal. 

20 [0005] Der Erfindung liegt die Aufgabe zu Grunde ein verbessertes Fahrerassistenzsystem zu schaffen. 

[0006] Die der Erfindung zu Grunde liegende Aufgabe wird mit den Merkmalen des unabhangigen Patentanspruchs 
gelost. Bevorzugte Ausfuhrungsformen der Erfindung sind in den abhangigen PatentansprGchen angegeben. 
[0007] Erfindungsgemaft wird nicht nur der Abstand eines Hindernisses zu dem Fahrzeug, sondern die Position des 
Hindernisses bestimmt. Dies erfolgt beispielsweise basierend auf dem Prinzip der Triangulation. 

25 [0008] Zur Durchfuhrung einer Positionsbestimmung mittels Triangulation ist die Messung des Abstandes zwischen 
dem Fahrzeug und dem Hindernis von zwei verschiedenen Positionen, das heiftt von zwei an unterschiedlichen Stellen 
des Fahrzeugs angeordneten Abstandssensoren erforderlich. 

[0009] Beispielsweise sind am Fahrzeugheck an der linken und rechten Fahrzeugseite jeweils ein Short-Range- 
Radarsensor angeordnet. Ein hinter dem Fahrzeug befindliches Hindernis wird von beiden der Abstandssensoren 
30 erfasst und der Abstand des Hindernisses zu dem linken und dem rechten Sensor wird dann ermittelt. Aus den beiden 
von den verschiedenen Positionen der Sensoren aus ermittelten Abstanden wird dann die Position des Hindernisses 
mit Bezug auf das Fahrzeug nach dem Prinzip der Triangulation berechnet. 

[0010] Wenn ein Mindestabstand zu dem Hindernis unterschritten wird, liefert zumindest einer der Radarsensoren 
kein hinreichend genaues Messsignal mehr, so dass eine Positionsbestimmung des Hindernisses mittels Triangulation 
35 nicht mehr moglich ist. Erfindungsgemafl wird deshalb bei Unterschreitung eines Mindestabstands eine Weg- und 
Lenkwinkelmessung mit fur die Bestimmung der Position des Hindernisses herangezogen. 

[001 1] Alternativ zur Lenkwinkelmessung mittels eines Lenkwinkelsensors kann auch die Gierrate ausgewertet wer- 
den. Die Gierrate wird von einem ESP-Steuergerat ohnehin ermittelt. 

[0012] Hierzu wird von der letzten durch Triangulation bestimmten Position des Hindernisses ausgehend eine aktu- 
40 elle Position des Hindernisses ermittelt, indem zu der letzten durch Triangulation bestimmten Position die Bewegung 
des Fahrzeugs aufgrund einer Erfassung des von dem Fahrzeug zuruckgelegten Wegs und einer Lenkwinkelmessung 
vektoriell aufaddiert wird. 

[0013] Von besonderem Vorteil ist hierbei, dass eine Fahrerassistenz auch im Nahbereich, das heifit bei Unterschrei- 
ten des fur die Funktion der Abstandssensoren erforderlich en Mindestabstands, noch gewahrleistet ist, da in diesem 
45 Bereich die Positionsbestimmung nicht mittels der Abstandssensoren, sondern mittels Weg- und Lenkwinkelmessung 
ausgehend von der letzten durch Triangulation bestimmten Position erfolgt. 

[0014] Bei der Bestimmung der Position des Hindernisses im "blinden Bereich" wird also bevorzugt wie folgt vorge- 
gangen. Ausgehend von der letzten bekannten Position, die mittels Triangulation bestimmt wurde, wird auf der Grund- 
lage der Daten der Radsensoren und des Lenkwinkelsensors die nachste Position des Hindernisses relativ zum Fahr- 

50 zeug bestimmt. Dieses Vorgehen wird von Messzyklus zu Messzyklus wiederholt. 

[001 5] Somit kann eine vollstandige Modellierung der Trajektorie des Fahrzeugs und der Position des Hindernisses 
erfotgen, das heifit die Position des Hindernisses ist auch bei Kurvenfahrt immer bekannt. Aufgrund dessen kann 
insbesondere ermittelt werden, ob das Fahrzeug bei einer Kurvenfahrt an dem Hindernis vorbeifahrt oder ob es bei 
einer Weiterbewegung zu einer Kollision kommt und ein entsprechender Warnhinweis gegeben werden muss. 

55 [0016] Nach einer bevorzugten Ausfiihrungsform der Erfindung erfolgt die Ermittlung einer Kontur des Hindernisses 
durch Vermessung der Kontur mit Hilfe von Abstandssensoren. Uber diese Kontur des Hindernisses wird eine konvexe 
Hulle definiert. Wenn ein Mindestabstand des Fahrzeugs zu der konvexen Hiille unterschritten wird, wird ein Warnsignal 
abgegeben. 
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[0017] Dies ist insbesondere vorteilhaft, wenn in einer Parklucke eines der parkenden Fahrzeuge mit einer Anhan- 
gerkupplung oder einem anderen herausragenden Objekt versehen ist, welches in den Parkbereich hineinreicht. Der 
Einparkvorgang kann dann aufgrund der die Anhangerkupplung bzw. das herausragende Objekt umfassenden kon- 
vexen Hulle optimiert werden, so dass auch eine Fahrerassistenz bei besonders engen Parklucken gegeben ist. 
5 [001 6] Nach einer weiteren bevorzugten Ausfuhrungsform der Erfindung wird ein in dem Fahrzeug oftmals ohnehin 
vorhandenes Electronic Stability Program (ESP) fur die Wegmessung verwendet. 

[0019] Im Weiteren werden bevorzugte Ausfuhrungsformen der Erfindung mit Bezugnahme auf die Zeichnungen 
naher erlautert. Es zeigen: 


10 Fig. 1 ein Fahrzeug mit einem erfindungsgemafien Fahrerassistenzsystem einer ersten Ausfuhrungsform; 

Fig. 2 ein Fahrzeug mit einem erfindungsgemaften Fahrerassistenzsystem einer zweiten Ausfuhrungsform; 

Fig. 3 ein Flussdiagramm zur Veranschaulichung der Arbeitsweise einer Ausfuhrungsform eines erfindungsgema- 
15 Ren Fahrerassistenzsystems; 

Fig. 4 ein Flussdiagramm zur Veranschaulichung der Arbeitsweise einer weiteren Ausfuhrungsform des Fahreras- 
sistenzsystems. 

20 [0020] Die Fig. 1 zeigt ein Kraftfahrzeug mit einem Steuergerat 1 . In dem Ausfiihrungsbeispiel der Fig. 1 handelt es 
sich bei dem Steuergerat 1 urn ein SRR-Parkpilot-Steuergeratzur Realisierung einer Fahrerassistenzfiirdas Einparken 
mittels Short-Range-Radarsensoren. 

[0021] Das Steuergerat 1 ist mit einem Wegsignalgeber 2 verbunden. Als Wegsignalgeber konnen ein oder mehrere 
Raddrehzahlsensoren des Fahrzeugs verwendet werden. 
25 [0022] Ferner ist das Steuergerat 1 mit mehreren SRR-Sensoren 3 verbunden, wobei jeweils vier SSR-Sensoren 3 
entlang des vorderen und des hinteren StoBfangers des Fahrzeugs angeordnet sind. 

[0023] Das Steuergerat 1 ist ferner mit einem Lenkwinkelsensor 4 verbunden. Uber den Lenkwinkelsensor 4 wird 
der Einschlagwinkel der Lenkung des Fahrzeugs erfasst. 

[0024] Ferner ist eine Anzeigeeinrichtung 5 mit einem Ausgang des Steuergerats 1 verbunden. Bei der Anzeigeein- 
30 richtung 5 kann es sich zum Beispiel urn eine optische und / oder akustische Anzeigeeinrichtung handeln; zusatzlich 
oder alternativ kann auch eine haptische Ausgabe vorgesehen sein. 

[0025] Uber die SRR-Sensoren 3 erfolgt die Bestimmung einer Position eines vor bzw. hinter dem Fahrzeug befind- 
lichen Hindernisses bei einem Einparkvorgang. Eine solche Positionsbestimmung ist nur dann moglich, sofern dass 
Hindernis von zumindest zwei der SRR-Sensoren 3 an der Vorder- bzw. Ruckseite des Fahrzeugs erfasst wird, so 

35 dass eine Triangulation aufgrund der entsprechenden Abstandswerte durchgefuhrt werden kann. 

[0026] Unterh alb eines Mindestabstands kann eine solche Positionsbe stimmun g nicht mehr vorg enomm en werden, 

da nur ein oder kein Abstandssignal von den SRR-Sensoren 3 geliefert wird. In diesem Fall wird die Position des 
Fahrzeugs mittels der von dem Wegsignalgeber 2 und dem Lenkwinkelsensor 4 gelieferten Signale durch das Steu- 
ergerat 1 vorgenommen. Dies erfolgt so, dass ausgehend von der letzten durch Triangulation bestimmten Position die 

40 Position des Fahrzeugs durch Modellierung der Trajektorie des Fahrzeugs entsprechend des bei einem bestimmten 
Lenkwinkeleinschlag zuriickgelegten Wegs bestimmt wird. 

[0027] Sobald ein definierter Mindestabstand an einer Stelle der Auflenkontur des Fahrzeugs zu dem Hindernis 
unterschritten wird, gibt das Steuergerat 1 uber die Anzeigeeinrichtung 5 ein Wamsignal fur den Fahrer ab. Alternativ 
oder zusatzlich wird das Fahrzeug automatisch abgebremst, urn eine Kollision zu verhindern. 
45 [002B] Die Fig. 2 zeigt eine alternative Ausfuhrungsform, bei der zusatzlich ein ESP-Steuergerat 6 vorhanden ist. 
Im Unterschied zu der Ausfuhrungsform der Fig. 1 sind der Wegsignalgeber 2 und der Lenkwinkelsensor 4 nicht un- 
mittelbaran das Steuergerat 1, sondern an das ESP-Steuergerat 6 angeschlossen. Das Steuergerat 1 erhaltdie Weg- 
und Lenkwinkelsignale in diesem Ausfiihrungsbeispiel von dem ESP-Steuergerat 6. 

[0029] Zusatzlich konnen auch seitlich an dem Fahrzeug weitere SRR-Sensoren 3 angeordnet sein, wie in der Fig. 
50 2 dargestellt. Diese seitlich angeordneten SRR-Sensoren 3 konnen zurErfassung einer AuRenkonturdes Hindernisses 
verwendet werden. 

[0030] Typischerweise erfolgt der Einparkvorgang so, dass zunachst an der Parklucke vorbeigefahren wird, urn un- 
mittelbar hinter der Parklucke zu stoppen, und dann riickwarts in die Parklucke hineinzufahren. Bei der Vorbeifahrt an 
der Parklucke erfolgt eine seitliche Erfassung der AuRenkontur von in der Parklucke befindlichen oder in die Parklucke 
55 hineinragenden Hindernissen, wie zum Beispiel einer Anhangerkupplung. Uber die AuRenkontur der die Parklucke 
begrenzenden parkenden Fahrzeuge wird eine konvexe Hulle gelegt, in die die Begrenzung des einzuparkenden Fahr- 
zeugs nicht eindringen darf, das heifit das Fahrzeug muss bei dem Einparkvorgang einen vorgegebenen Mindestab- 
stand von der konvexen Hulle einhalten. Dadurch wird ermoglicht, dass auch bei in die Parklucke hineinragenden 
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Hindernissen, wie zum Beispiel einer Anhangerkupplung. derfurdas Einparken nutzbare Raum optimal genutztwerden 

kann. 

[0031] Die Fig. 3 veranschaulichtden Ablaut beim Betrieb des erfindungsgemalien Fahrerassistenzsystems. Indem 
Schritt 30 erfolgt die Bestimmung der Position eines Hindernisses mit Bezug auf das Fahrzeug nach dem Prinzip der 
5 Triangulation uber an dem Fahrzeug angebrachte Abstandssensoren. 

[0032] Indem Schritt 31 wird gepruft, ob mindestens zwei der Abstandssensoren ein hinreichendgenaues Abstands- 
signal zu dem erfassten Hindernis liefem. Dies ist bei Unterschreitung eines Mindestabstands zu dem Hindernis nicht 
mehr der Fall. 

[0033] Wenn von den Abstandssensoren hinreichende Abstandssignale vorliegen, geht die Ablaufsteuerung zuruck 
10 zu dem Schritt 30, urn die aktuelte Position des Hindernisses mit Bezug auf das Fahrzeug erneut zu bestimmen. 

[0034] Ist jedoch das Gegenteil der Fall, das heifit liegt nur ein Oder kein hinreichendes Abstandssignal der Ab- 
standssensoren vor, da der Mindestabstand unterschritten worden ist, geht die Ablaufsteuerung zu dem Schritt 32. In 
dem Schritt 32 erfolgt die Bestimmung der Position des Hindernisses mit Bezug auf das Fahrzeug basierend auf der 
letzten in dem Schritt 30 ermittelten Position des Hindernisses, wobei der von dem Fahrzeug seit der letzten Positi- 
15 onsbestimmung zuruckgelegte Weg vektoriell aufgrund der Lenkwinkelbestimmung aufaddiert wird. Auf diese Art und 
Weise erhalt man die Position des Hindernisses im Nahbereich. 

[0035] Nach dieser Positionsbestimmung im Schritt 32 geht die Ablaufsteuerung zuruck zu dem Schritt 31 . urn zu 
prufen, ob hinreichende Signale von den Abstandssensoren vorliegen. 

[0036] Die Fig. 4 zeigt eine weitere bevorzugte Ausfuhrungsform des Fahrerassistenzsystems. In dem Schritt 40 
20 liefern die als SRR-Sensoren ausgebildeten Abstandssensoren hinreichend genaue Abstandswerte, so dass die Po- 
sition eines Hindernisses mittels Triangulation bestimmt werden kann. Die aufgrund dieser Messungen bestimmter 
Fahrzeugtrajektorie wird mit dem Wegsignalgeber und / oder dem Lenkwinkelsensor abgeglichen, urn einen Korrek- 
turwert zu erhalten. 

[0037] In dem Schritt 41 erfolgt die Navigation im "blinden Bereich", das heifit in einem Bereich von weniger als ca. 
25 20 cm bis 50 cm von dem Hindernis entfernt. In diesem Bereich wird mittels Koppelnavigation navigiert, das heifit die 
aktuelle Hindernisposition wird ausgehend von der letzten durch Triangulation bestimmten Position durch vektorielle 
Aufaddierung des zuriickgelegten Wegs ermittelt. 

[0038] In dem Schritt 42 wird gepruft, ob sich zwischen dem Hindernis und dem Fahrzeug ein Objekt befindet. Wenn 
dies der Fall ist, wird in dem Schritt 43 eine optische und / oder akustische und / oder haptische Warnung abgegeben. 
30 1st kein solches Objekt vorhanden, so wird in dem Schritt 44 gepruft, ob sich ein Punkt der FahrzeugauBenkontur 
soweit an das Hindernis angenahert hat, dass ein minimaler Sicherheitsabstand unterschritten worden ist. Wenn dies 
der Fall ist, wird der Schritt 43 ausgefiihrt. Wird der Sicherheitsabstand nicht unterschritten, so wird der Schritt 44 
ausgefuhrt, das heifit es erfolgt keine Warnung. 

35 Bezugszeichenliste 

[0039] 

Steuergerat 1 
40 Wegsignalgeber 2 
SRR-Sensoren 3 
Lenkwinkelsensor 4 
Anzeigeeinrichtung 5 
ESP-Sleuergerat 6 

45 

Patentanspruche 

1. Fahrerassistenzsystem fur ein Fahrzeug mit 

50 

Mitteln (3) zur Bestimmung einer ersten Position eines Hindernisses mit Bezug auf das Fahrzeug, solange 
das Fahrzeug einen Mindestabstand zu dem Hindernis hat, 

Mitteln (2)zur Bestimmung einer zweiten Position des Hindernisses bei Unterschreitung des Mindestabstands 
55 basierend auf einer Weg- und Lenkwinkelmessung. 

2. Fahrerassistenzsystem nach Anspruch 1, bei dem die Mittel zur Bestimmung einer ersten Position eines Hinder- 
nisses einen oder mehrere Radarsensoren, vorzugsweise Short-Range-Radarsensoren (SRR) einen oder meh- 
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rere Ultraschall- Oder optische Sensoren aufweisen. 

3. Fahrerassistenzsystem nach Anspruch 1 oder 2, bei dem die Mittel zur Bestimmung einer ersten Position eines 
Hindernisses erste Sensormittel zur Bestimmung einer ersten Entfernung des Fahrzeugs von dem Hindernis und 

5 Mittel zur Bestimmung einer zweiten Entfernung des Fahrzeugs von dem Hindernis aufweisen und Mittel zur Be- 

rechnung der ersten Position mitteis Triangulation aus der ersten und der zweiten Entfernung. 

4. Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1, 2 oder 3 mil 
10 - Sensormitteln zur Ermittlung einer Aulienkontur des Hindernisses, 

Mitteln zur Festlegung einer konvexen Hulle urn die Aulienkontur des Hindernisses, 

Mitteln zur Abgabe eines Signals, wenn ein Mindestabstand des Fahrzeugs von der konvexen Hulle unter- 
15 schritten wird. 

5. Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 4 mit Mitteln (1) zur Umschaltung der 
Bestimmung der Position des Hindernisses von den Mitteln zur Bestimmung einer ersten Position zu den Mitteln 
zur Bestimmung einer zweiten Position, wenn eine Unterschreitung des Mindestabstands zu dem Hindernis de- 

20 tektiert wird. 

6. Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 5, wobei die Mittel zur Bestimmung einer 
zweiten Position des Hindernisses zur Erfassung der von einem oder mehreren Raddrehzahlsensoren gelieferten 
Signale fur die Wegmessung ausgebildet sind. 

25 

7. Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 6, wobei die Mittel zur Bestimmung einer 
zweiten Position des Hindernisses zur Erfassung der von einem Electronic Stability Program (ESP) (6) abgege- 
benen Signale fur die Wegmessung ausgebildet sind. 

30 8. Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 7 mit Mitteln zur automatischen Abbrem- 
sung des Fahrzeugs, wenn ein Sicherheitsabstand zu dem Hindernis unterschritten wird. 

Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 8, wobei es sich urn einen Parkpilot, 
eine Backing Aid, einen Auffahrunfalldetektor oder dergleichen handelt. 


55 
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SRR-Sensoren liefern Abstandswerte: Abgleich mit den 
Messungen der Radsensoren 
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Navigation im blinden Bereich (ca.< 50cm): Ermittlung des 
Sicherheitsabstandes bis zum Hindemis auf Basis der letzten 
Messung der Umfeldsensoren, dei Messungen der 

Radsensoren und des Lenkwinkelsensors 
(zyklische Ermittlung der Position des Hindemisses) 


Objekt- \ ja 
Detektion zw. Hindemis 
und Fahrzeug? 



keine Warming ^ 


optische/akustische 
Warnung 
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